(19) 



EuropSlsches Patentamt 
European Patent Office 
Office europ6en dee brevets 



II 



(11) 



EP1 594 022 A1 



(12) 



EUROPEAN PATENT APPLICATION 

published in accordance witli Art. 158(3) EPC 



(43) Date of publication: 


(51) lntci7: G05B 11/36. G05B 13/02, 


09.11.2005 Bulletin 2005/45 


G05B 13/04 


(21) Application number: 04711481.4 


(86) International application number: 


(22) Date of filing: 16.02.2004 


PCT/JP2004A)01624 




(87) International publication number: 




WO 2004A)79462 (16.09.2004 Gazette 2004^8) 


(84) Designated Contracting States; 


(72) Inventors: 


AT BE BG OH CY CZ DE DK EE ES Fl FR GB GR 


• KANAOKA, Katsuya. RItsumeikan Uni., 


HU IE IT LI LU MC NL PT RO SE SI SK TR 


Dept. Robotics 


Designated Extension States: 


Kuaatsu-shi, Shiga 525-8577 (JP) 


AL LT LV MK 


• YOSHIKAWA,Tsuneo 




Nara-shi, Nara 631 -0806 (JP) 


(30) Priority: 14.02.2003 JP 2003036056 




20.09.2003 JP 2003366681 


(74) Representative: Pfenning, Meinig 8t Partner GbR 




Joachinnstaier Strasse 10-12 


(71) Applicant: Kansai Technology Licensing 


10719 Berlin (DE) 


Organization Co., Ltd. 




Kyoto-shI, Kyoto 600-8815 (JP) 





(54) CONTROL SYSTEM HAVING VIRTUAL POWER MONITOR FOR REALIZING FUNCTION TO 
EVALUATE/ANALYZE STABILITY OF CONTROL OBJECT 



CM 
CM 
O 

o 

LO 



(57) The p resent Inventio n relates to a system con- 
figuration that can evaluate the stability of an output from 
a user's control system Including all effects of unknown 
dynamic characteristics and disturbances and can guar- 
antee the stability of the output from the user's control 
system irrespective of the unknown dynamic character- 
istics and the disturbances. 

That is, the control system of the present invention, 
which is provided with a virtual power monitor and is 
thereby provided with a function of evaluating and ana- 
lyzing the stability of an object to be controlled, Is such 
that In a user's control system 2' In which the user's con- 
trolled object 3 is controlled by the user's control strat- 
egy 5: Includes: a conservative control strategy 104, 
which receives a feedback signal from the user's con- 
trolled object 3 and can input acontrol input to the user's 
controlled object 3; and a virtual power monitor 110, 
which monitors power virtu ally transmitted from the con- 
servative control strategy 104 to the user's controlled 
object 3, and can evaluate the stability of an output from 
the user's control system 2'. 
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Description 

TECHNICAL FIELD 

5 [0001] The present invention relates to a common control system In a mechanical field, an electric and electronic 
field, a chemical field or the like. The present invention can be applied to a wide variety of control systems of, for 
example, robots, machine tools, automobiles, electric and electronic circuits, chemical plants and the like. 

BACKGROUND ART 

10 

[Non-patent document 1] 

[0002] "Control Theory of No n- 11 near Mechanical Systems - A Passivity-based and Circuit-theoretic Approach*, by 
S. Arimoto, Oxford Science Publication, 1996. 

15 

[Non-patent document 2] 

[0003] "Bilateral Control with Energy Balance Monitoring UnderTime-Varyingcommunication Delay", by Y.Yokol(ohji, 
T. Imaida, and T. Yoshikawa. Proceedings of the 2000 IEEE International Conference on Robotics and Automation, 
20 page 2684-2689. 2000. 

[Non-patent document 3] 

[0004] "Control of a Flexible Manipulator with Noncollocated Feedback: Time Domain Passivity Approach", by J.H. 
25 Ryu, D.S. Kwon, and B. Hannaford, Control Problems in Robotrcs^ Springer Tracts in Advanced Robotics, Vol. 4, page 
121-134, 2003. 

[0005] To secure the safety of a control system, it is necessary to guarantee that "an object to be controlled Is not 
brought to an unstable state (does not run away out of control) under any conditions". On this account, it is common 
to add a hardware-like limiter (hardware llmiter) to the control system. 
30 [0006] On the other hand, passivity (for example, refer to non-patent document 1 }, which is the feature of a physical 
system, has received attention as a theoretical scheme to guarantee stability. 

[0007] A system that monitors the energy balance of a specific system with attention given to passivity to limit ac- 
cumulated energy to thereby secure stability is already proposed as energy balance monitor (non-patent document 2) 
and passivity observer/passivity controller (non-patent document 3). The conceptual diagram of these conventionally 

35 known systems is shown in FIG. 1 7. 

[0008] By the way, evaluation criteria of the stability of a user's controlled object, which are used for detennining the 
operation of a hardware limiter in a common control system, are the limitation of an operating range, the limitation of 
current and velocity for an actuator, and the like, which are rough In distinction between stability and instability. More- 
over, there Is also a possibility that once a limiter is activated in a system, the system Is thereafter out of control and 

40 causes a secondary disaster Even if the system does not come to cause a disaster, in many cases, it takes a great 
deal of time and labor to restart the system. 

[0009] Further, the energy balance monitor of the non-patent document 2 secures the passivity of a transmission 
line between a master and a slave and the passivity observer/ passivity controller of the non-patent document 3 secures 
the passivity of virtual space of a haptic system, respectively, but they do not guarantee the stability of a control system 

45 including an arbitrary control strategy, an arbitrary controlled object, and an arbitrary disturbance in a real world. 
[0010] Still further, In the systems described in the non-patent documents 2, 3, on the assumption that the user's 
controlled object 3 is passive, the user's control strategy 5 Is made virtually passive on the basis of the ot)servation of 
energy balance to guarantee the stability of the whole system. However, if the user's controlled object 3 is not passive, 
the stability of the system cannot be guaranteed. Although most of the phystoal systems as the user's controlled object 

50 3 are passive, the systems cannot cope with, for example, a situation where an actuator Is connected In opposite 
polarity by mistake to operate opposite to a driving Input. If not such an extreme example, the system cannot cope with 
also instability caused by disturbances having direct effect on the user's controlled object. 
[0011] Therefore, it is an object of the present invention to provide a system configuration that can not be realized 
by a conventional technology, that Is, keeps control perfonmance as high as possible for a user's control system, which 

5S has its arbitrary user's controlled object controlled by an arbitrary user' s control strategy and undergoes the effect of 
an artsitrary disturiaance, and at the same time guarantees the stability of the user's controlled object. 
[0012] Further, it is another object of the present invention to provide a system configuration that can evaluate the 
whole user's control system including all effects from the outside worid and can guarantee the stability of the whole 
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system. 

[001 3] Stifl further, it is still another object of the present invention to provide a systenn configuration that can guarantee 
the stability of a user's controlled object even if it is not assumed that the user's controlled object is passive. 

5 DISCLOSURE OF THE INVENTION 

[001 4] The present inventors have found that the above-described object can be attained by fomning a system con- 
figuration in which a function (passivity monitor) of monitoring the passivity of a control system to quantitatively evaluate 
the stability of the control system and an Intelligent iimiter function (software limiter) capable of suppressing only an 
10 unstable action without Interrupting control at the time of detecting the unstable action are added to an existing system , 
and have invented the present invention. 

[0015] Moreover, the present Inventors have found the following facts: in place of "monitoring the passivity of the 
control system" to quantitatively evaluating the stability of a control system in the related art (passivity monitor), as will 
be described later, power (virtual power) virtually transmitted from a conservative control strategy to a user's controlled 

15 object is monitored to evaluate and analyze the stability of a user's control system (virtual power monitor), and in place 
of a software limiter of functioning in such a way as to prevent passivity from being lost according to the evaluation of 
passivity, as will be described later, a virtual power limiter is employed which tunes the user's control system by some 
means on the basis of the monitoring of the virtual power in the virtual power monitor to limit the outflow of the virtual 
power from the user's control system and thereby functions in such a way as to guarantee the stability of the user's 

20 control system, and if a virtual power iimiter system including these "Virtual power monitor" and "virtual power limiter" 
Is added to the user's control system to fomn a system configuration, the control system that is provided with the above- 
described passivity monitor and is thereby provided with a function of evaluating and analyzing the stability of the object 
to be controlled can be further generalized as the virtual power limiter system for guaranteeing the stability of the control 
system and hence can be extended in the scope of application. Under this virtual power limiter system, the configuration 

25 of each control system paying attention to the above-described passivity (refer to the first embodiment to be described 
later) is one example in the case where the virtual power limiter system is designed on the basis of the concept of the 
passivity. 

[001 6] Moreover, according to the virtual power limiter system of the present invention , also in a power assist system 
for assisting the power of a human by the use of a robot, it Is possible to limit power flowing out to the human from the 
30 power assist robot inrespective of the dynamic characteristics of the human being unlcnown and hence to secure safety 

to the human. 

[0017] A control system of the present invention capable of attaining the above object is 

(1 ) characterized in that in an existing system having a user's controlled object controlled by a user's control strat- 
35 egy, the control system includes: an internal control strategy, which receives a feedback signal from the user's 

controlled object and inputs a control input to the user's controlled object; and a passivity monitor, which monitors 
the passivity of a monitored system including the existing system from the input/ output of the monitored system 
(shown in FIG. 1 ), and can evaluate and analyze the stability of the user's control system. 

(2) in the control system of the present invention, the user's controlled object can be typified by a mechanical 
^0 system including a robot, but is not limited to this. The present invention can be applied also to various kinds of 

system in an electric and electronic field, a chemical field, and the like. 

(3) In the control system of the present invention, an input to the monitored system can be typified by force or 
torque and an output from the monitored system can be typified by velocity or angular velocity, but they are not 
limited to these. The input to the monitored system may be a physical quantity other than force or torque and the 

^5 output from the monitored system may be a physical quantity other than velocity or angular velocity. 

Examples of the other physical quantity are pressure and volume change in gas, water, oil, or the like; voltage 
input and current output; cun^ent input and voltage output; or the like. These inputs and outputs can be arbitrarily 
selected if they are a pair of physical quantities for which the passivity can be defined (conjugate power pair). 

(4) In the control system of the present invention, a control input from the user's control strategy to the user* s 
50 controlled object and a control input from the Internal control strategy to the user's controlled object may be inputted 

to the user's controlled object by the same physical means or by different physical means (shown in FIG. 2), 
Examples of the different physical means can be typified by different motors in the same robot or the like. 

(5) Moreover, in the control system of the present invention, the control input from the user's control strategy to 
the user's controlled object and the control input from the internal control strategy to the user's controlled object 

55 have the same dimension but these two control inputs may be different from each other In the dimension. 

For example, in the case where the user's controlled object is a robot having six motors, the control system 
may be a control system such that the control input from the user's control strategy to the user's controlled object 
is expressed by six-dimensional vector to all six motors and that the control input from the internal control strategy 
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to the user's controlled object is expressed by three'dimensional vector to three motors of the six motors. 
(6) One condition of the internal control strategy in the present invention, as will be described later, is to be capable 
of guaranteeing stability to a passive system but even an internal control strategy not satisfying this definition can 
be employed as an Internal control strategy by adding an appropriate limlter (for example, the first software limiter) 

5 to it. 

Further, the present invention is such that includes a software limiter, which prevents the passivity of the 
monitored system from being lost (7) by tuning the quantity of negative feedback from the output of the monitored 
system to the input of the monitored system (the second software limiter, shown in FIG. 3) or (8) by tuning the 
control input from the user's control strategy to the user's controlled object (the third software limiter. shown in FIG. 
10 A) in the monitored system according to the evaluation of passivity by the passivity monitor and thereby guarantees 
the stability of the output from the monitored system. 

(9) Still further, the present invention is such that includes a software limiter, which tunes the control input from the 
Internal control strategy to the user's controlled object in the monitored system according to the evaluation of 
passivity by the passivity monitor (the fourth software limiter, shown in FIG. 5) and thereby guarantees the stability 

IS of the output from the monitored system and keeps controlling the user's controlled object. 

(1 0) By appropriately detenmining a tuning strategy by the above-mentioned software limiter, it is possible to quan- 
titatively and arbitrarily detennine the extent to which the instability of the internal control strategy Is allowed, the 
extent to which the Instability of the user's controlled object is allowed, the extent to whtoh the passivity of the 
monitored system is recovered quickly, or the extent to which the internal control strategy Is substituted for the 

20 user's control strategy 

(11) In addition, by applying tuning by the above-described software limiter to the gains of the quantity of negative 
feedback from the output of the monitored system to the input of the monitored system, the user's control strategy, 
or the internal control strategy, It is also possible to automatically tune at least any one of the gains of the quantity 
of negative feedback: the user's control strategy, or the Internal control strategy In such a way that the stability of 

25 the output from the monitored system is guaranteed. 

Moreover, the present invention is characterized in that a control system provided with the above-described 
passivity monitor and thereby provided with a function of evaluating and analyzing the stability of an object to be 
controlled is further generalized as a virtuatpowerlimitersystemforguaranteeing the stability of the control system, 
thereby being extended in the scope of application. 

30 The above-described generalized control system of the present invention Is (12) characterized in that in a 

user's control system in which a user's controlled object is controlled by a user's control strategy, the control system 
includes: a conservative control strategy, which receives a feedback signal from the user's controlled object and 
can input a control input to the user's controlled object; and a virtual power monitor, which monitors power virtually 
transmitted from the conservative control strategy to the user's controlled object, and can evaluate and analyze 

3s the stability of the user's control object. 

Further, the control system of the present invention is characterized in that the control system further includes 
a virtual power limiter. which (1 3) tunes the quantity of negative feedback from the output from the user's control 
system to an Input to the user's controlled object or (14) tunes a control Input from the user's control strategy to 
the user's controlled object in the user's control system on the basis of the monitoring of virtual power in the virtual 

40 power monitor to thereby limit the outflow of the virtual power from the user's control system to a virtual power 
monitor system, and thereby guarantees the stability of the output from the user's control system. 

(15) Still further, the control system of the present invention is characterized In that the control system further 
includes a virtual power limiter which tunes a control input from the conservative control strategy to the user's 
controlled object in the user's control system on the basis of the monitoring of virtual power in the virtual power 

^5 monitor, and thereby guarantees the stability of the output from the user's control system and keeps controlling 
the user's controlled object. 

(1 6) In addition, according to the present invention, by applying tuning by the virtual power limiter to the gain of 
the quantity of negative feedback from the output of the user's control system to the input to the user's controlled 
object, the user's control strategy, or the conservative control strategy, it Is also possible to automatically tune at 

so least one of the gains of the quantity of negative feedback, the user's control strategy, or the consen/ative control 
strategy in such a way that the stability of the output of the user's control system is guaranteed. 

Next, the above-described virtual power limiter system can be applied also to a power assist system for as- 
sisting the power of a human by the use of a robot. (17) A control system of the present invention constructed at 
this time Is characterized in that the control system includes: a power assist system (corresponding to the above- 

55 described user's control system), which has a user's controlled object controlled by an operator and includes a 
power assist control strategy (corresponding to the above-described user's control strategy) that receives a feed- 
back signal from the user's controlled object and assists to Input a control input from the operator to the user's 
controlled object; and a virtual power monitor that monitors power transmitted from the operator to the user's 
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controlled object, and can evaluate and analyze the stability of the user's controlled object. 

Further, the control system of the present invention Is characterized in that the control system further includes 
a virtual power llmiter, which (18) tunes the quantity of negative feedback from the output from the power assist 
system to an input to the user's controlled object or (1 9) tunes a control input from th © power assist control strategy 
5 to the user's controlled object in the power assist system on the basis of the monitoring of virtual power in the 

virtual power monitor to limit the outflow of the virtual power from the power assist system to a virtual power monitor 
system, and thereby limits power flowing out of the power assist system to the operator to guarantee the stability 
of the output from the power assist system to thereby secure safety to the operator. 

(20) In addition, according to the present invention, by applying tuning by the virtual power llmiter to the quantity 
10 of negative feedback from the output of the power assist system to the Input to the user's controlled object, or to 
the power assist control strategy, it is also possible to automatically tune the gain of at least one of the quantity of 
negative feedback and the power assist control strategy in such a way that the stability of the output of the power 
assist system to secure safety to an operator Is guaranteed. 

'5 [0018] Hereafter, technical terms to be used tor the description of the present invention will be defined. 

[0019] First, the definition of "passivity" is given. Assume that an input vector u (t) and an output vector y (t) of a 
certain system have the same dimension (both of them may be scalars) where t=0 is the initial time and I Is the present 
time. At this time, the following inequality is satisfied, it is said thatthe system satisfies passivity (or is passive). However, 
in the Inequality (1). >s a bounded positive constant and commonly expresses internal energy at the initial time t=0 

20 of the system. 



j;/(r)w (r)dr^-r.' ('/>o) (1) 

25 

[0020] "Conjugate power pair" mean a pair of physical quantities for which passivity can be defined as the input/ 
output of a system. Examples of a conjugate power pair Include force and velocity, torque and angular velocity, voltage 
and current, and the like. In the present invention, assume that even if the system does not always satisfy passivity in 
30 reality, a pair of physical quantities for which passivity can be defined Is called a conjugate power pair. 

[0021 ] "User's controlled object' means a physical system specified by the user of the present invention . An arbitrary 
system can be a user's controlled object if the system has at least a conjugate power pair as a pair of input and output. 
However the user's controlled object is not necessarily passive. 

[0022] "User's control strategy" means a control strategy that the user of the present invention arbitrarily specifies 
35 to control the user's controlled object. The input and output between the user's control strategy and the user's controlled 
object are not necessarily a conjugate power pair but can be arbitrary physical quantities selected by the user. 
[0023] "Existing system" means a system in which the user' s control strategy Inputs a control Input to the user's 
controlled object to control the user's controlled object. An arbitrary unknown disturbance can be Input to the existing 
system. 

40 [0024] In this regard, assume that "existing system" does not include the constituent elements of weights of an 
internal control strategy, a passivity monitor, a software limiter, and the like, which will be described later. 
[0025] "Monitor system" means a system which outputs a control input from the internal control strategy to the user's 
controlled object and to which feedback from the user's controlled object to the internal control strategy is inputted. 
The monitor system can be completely externally added to an arbitrary existing system. 

45 [0026] When the present invention will be described below, assume that the monitor system includes not only an 
internal control strategy but also a passivity monitor. 

[0027] "Monitored system" means a system to which a control input from the internal control strategy to the user's 
controlled object is inputted and which outputs feedback from the user's controlled object to the internal control strategy. 
The monitored system includes all sections not included In the monitor system (existing system, disturbance, and the 

so like) and becomes an object whose passivity is monitored by a passivity monitor. 

[0028] "Internal control strategy* means a control strategy that feeds back the output from the user's controlled object 
and inputs a control input to the user's controlled object to be able to guarantee the stability of the output when the 
user's controlled object is passive for the input and the output. Hence, the input and output between the Internal control 
strategy and the user's controlled object needs to be a conjugate power pair. The same physical quantities or absolutely 

55 independent physical quantities may be selected for the input and output between the internal control strategy and the 
user's controlled object and the input and output between the user's control strategy and the user's controlled object. 
[0029] "Passivity monitor" means a means for monitoring the passivity of the monitored system for a control input 
from the Internal control strategy with the aid of the input and output between the monitor system and the monitored 
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system. 

[0030] "Software limiter" means a system constituent element that imposes some limit to at least one section of the 
control system to contribute to guaranteeing the stability of the output of the user's controlled object with control per- 
fonnance held as high as possible. Software llmiters in one embodiment of the present invention to be described below 

5 include the first to fourth software llmiters. 

[0031 ] IVIoreover, technical temis to be used for description of the generalized present invention will be provided. 
[0032] "User's control system" means a system to which a control input from a consen/atlve control strategy to a 
user's controlled object is inputted and which outputs feedbacic from the user's controlled object to the conservative 
control strategy. The user's control system becomes an object to be monitored by a virtual power monitor system. 

10 [0033] This "user's control system" is. by definition, the same as the above-mentioned "monitored system" and Is a 
concept capable of including not only the existing system but also the weight of the virtual power limiter and the Wke, 
The user's control system can have an arbitrary unknown disturbance inputted thereto. 

[0034] "Conservative control strategy" means a control strategy that can guarantee the stability of an arbltraiy con- 
trolled object satisfying some condition (for example, passivity). Moreover, the conservative control strategy can feed 

15 back an output from a user's controlled object and can input (virtually connect) a control input to the user's controlled 
object. For example, when a virtual power limiter system is designed on the basis of passivity, the input and output 
between the conservative control strategy and the user's controlled object are a pair of physical quantities that can be 
a conjugate power pair. The conservative control strategy can be provided independently of the user's control strategy 
and corresponds to the above-described "internal control strategy". 

20 [0035] In this regard, "virtual connection (or virtually connect) " means as follows: for example, when viewed from a 
virtual power monitor system, as shown in FIG. 8, a control Input Up^^ ^^om a conservative control strategy 1 04 Indeed 
seems to be connected to a usei's control system 2 but, in reality, is subjected to a weight W^g^ in the user's control 
system 2 (inside surrounded by a broken line in FIG. 8) and the weight is usually reduced to zero (is not connected); 
therefore, this is called "virtual connection". 

25 [0036] Moreover, only when an unstable condition occurs and the conservative control strategy needs to substitute 
for the control function of the user's control strategy, this control input u^gy is actually connected to the user* s controlled 
object. However, even if the control input u^y is actually connected to the user's controlled object, unless the weight 
^csv = 1 • power Py monitored by a virtual power monitor 110 is different from the quantity of power actually flowing 
into a user's controlled object 3. l-lence, the expression of 'Virtual" is used also in this sense. 

30 [0037] Therefore, the above-described "virtual connection" expresses that a control input is at least in a state 
where the control input u^^ can be actually inputted although it Is not certain that the control input is actually 
inputted. 

[0038] "Virtual power" means power virtually transmitted from the conservative control strategy to the user's control- 
led object. 

35 [0039] "Vi rtual power monitor" means a means that monitors power (virtual power) transmitted from the conservative 
control strategy to the user's controlled object with the aid of the input and output between the virtual power monitor 
system and the user's control system to thereby evaluate and analyze the stability of the user's control system and 
corresponds to the above-described "passivity monitor". 

[0040] "Virtual power limiter* means a system constituent element that tunes the user's control system by some 
40 means on the basis of the monitoring of virtual power by the virtual power monitor to limit the outflow of the virtual 
power from the user control system to thereby guarantee the stability of an output from the user control system and 
corresponds to the above-described "software limiter". 

[0041] Moreover, s virtual power monitor system to be described next and this virtual power limiter are generically 
called a virtual power limiter system. 

45 [0042] "Virtual power monitor system" means a system, which outputs a control input from the conservative control 
strategy to the user's controlled object and to which feedback from the user's controlled object to the conservative 
control strategy is inputted, and corresponds to the above-described "monitor system". The virtual power monitor sys- 
tem can be so constructed as to be completely externally added to an arbitrary user's control system. 
[0043] When the present invention will be described below, assume that the virtual power monitor system Includes 

so not only the conservative control strategy but also the virtual power monitor 

[0044] As described above, the present invention provides a system construction that can be so constructed as to 
be completely externally added to an arbitrary existing system and quantltatrvety evaluates the stability of an output 
from an ariDitrary user's control system on the basis of the monitoring of virtual power by a virtual power monitor and 
further guarantees the stability of an output from the user's control system. According to the present invention, it is 

55 possible to enhance the performance of the user control system as much as possible or to hold Its performance as 
high as possible within a range in which stability can be held. 

[0045] The conceptual diagram of the above-described virtual power monitor system of the present invention is 
shown in FIG. 8. The whole of a user's control system 2' Is one monitored object and the conservative control strategy 
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104 designed independently of a user control strategy 5 Is virtually connected to the input and output of the user's 
control system 2'. By monitoring virtual power passing this connection, It is possible to evaluate the whole of the user 
control system 2' including all effects from the outside world and to guarantee the stability of the output from the user 
control system 2'. Moreover, because the virtual power Ilmiter system of the present invention is not predicated on the 
5 passivity Of the user's controlled object, it is possible to guarantee the stability of the output from the user control system 
2' even if the above-described actuator of opposite polarity and disturbance exist. 

[0046] In addition, a system having a plurality of control strategies, like the present invention, has other advantages. 
The user control strategy 5 can be an aggressive control strategy pursuing only control performance. That is, even a 
control strategy that Is not necessarily passive is allowed if it can enhance control perfonnanoe. A conservative control 
10 strategy is not related to control if it Is virtually connected and hence control performance does not need to be taken 

into account for the design of the conservative control strategy, 

[0047] On the other hand, an existing system is going to secure the passivity of the user's control strategy itself and 
hence cannot essentially realize only more conservative control perfomnance. 

[0048] In this manner, the present invention is very useful and widely applicable and can be easily mounted. In 
15 particular, the present invention is very useful for a user's control system that is required to guarantee stability with 
reliability iaespective of requiring a high degree of control or a high degree of tuning of gain. 
[0049] Hereafter, the present invention will be described in more detail. 

BRIEF DESCRIPTION OF THE DRAWINGS 

20 

[0050] 

FIG. 1 is a diagram showing one example of a control system of the present invention. 

FIG. 2 is a diagram showing another example of the control system of the present invention. 
25 FIG. 3 is a diagram showing still another example of the control system of the present invention. 

FIG. 4 is a diagram showing still another example of the control system of the present invention. 

FIG. 5 is a diagram showing still another example of the control system of the present invention. 

FIG. 6 is a diagram showing a monitored system of the control system of the present invention. 

FIG. 7 is a diagram showing a monitor system of the control system of the present Invention. 
30 FIG. 8 is a conceptual diagram of a. virtual power monitor system of the present invention. 

FIG. 9 is a diagram showing one example In which a virtual power ilmiter system of the present invention is added 

to a user's control system. 

FIG. 1 0 is a diagram showing one example in which the virtual power limiter systeno of the present Invention is 

added to a power assist system. 
35 FIG. 11 is a diagram showing one embodiment of the present invention. 

FIG. 12 is a diagram showing another embodiment of the present invention. 

FIG. 13 is a diagram showing still another embodiment of the present invention. 

FIG. 14 is a diagram showing still another embodiment of the present invention. 

FIG. 15 is a diagram showing stilt another embodiment of the present invention. 
40 FIG. 1 6 is a diagram showing one embodiment In which the virtual power limiter system of the present invention 

is applied to a power assist system. 

FIG. 17 is a diagram showing one example of the control system of the related art. 
BEST MODE FOR CARRYING OUT THE INVENTION 

45 

1 . First Embodiment 

[00S1] Hereafter, one embodiment and its operation of the present invention In a robot control system, which is a 
typical example of the object to which the present Invention is applied, will be described on the basis of FIG. 1 to FIG. 
so 7. A control system 1 in accordance with the present Invention is characterized mainly In that a passivity monitor and 
a software limiter are added to an existing system ex. First, 1) the reason why the stability of a control system can be 
quantitatively evaluated by a passivity monitor will be described, and then 2) the reason why the stability of an output 
of a monitored system can be guaranteed by a software limiter will be described. 

[0052] Here, FIG. 1 to FIG. 5 show Individual configurations of a passivity monitor 10 and software limiters (21a, 21b 
55 to 24a. 24b). Moreover, the respective constituent elements shown in FIG. 6 and FIG. 7 construct the control system 

1 of the present invention in combination. FIG. 1 shows a control system 1 in which a monitor system 11 including an 
internal control strategy 4 and the passivity monitor 1 0 of the present invention is added to the existing system ex. FIG. 

2 shows a case in which two control inputs are inputted to a user's controlled object 3 by different physical means In 
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the control system shown In FIG. 1 . FIG. 3 shows a case in which a second software limiters (22a, 22b) of the present 
invention are applied to the control system shown in FIG. 1 . FIG. 4 shows a case in which a third software limiters 
{23a, 23b) of the present Invention are applied to the control system 1 shown In FIG. 1 . FIG. 5 shows a case in which 
the third software limiters (23a, 23b) and the fourth software limiters (24a. 24b) of the present invention are applied to 

5 the control system 1 shown in FIG. 1 . FIG. 6 and FIG. 7 are diagrams showing the construction of the whole control 
system 1 of the present invention in which the existing system ex is provided with an Internal control strategy 4, the 
passivity monitor 10, and the first to fourth software limiters (21a, 21b to 24a, 24b) . The first software limiters (21a, 
21b), as shown In FIG. 7, are provided In the internal control strategy 4. The first software limiters (21a, 21b) include 
a weight tuning strategy 21 a and a weight 21 b (WJ. The weight Is connected to and controlled by the weight tuning 

10 strategy 21 a. A target value Input and the output y of the user's controlled object 3 are inputted to the weight tun ing 
strategy 21a. The output y of the user's controlled object 3 is connected to the weight W^. An output from the weight 
Is inputted as output from the internal control strategy 4 to the passivity monitor 10 and the monitored system 2 in 
FIG. 6 together with output from a control strategy 6 of a PI control strategy or the like. The first software limiters built 
in the internal control strategy 4 can be applied also to the control system 1 shown In FIG. 1 to FIG. 5. In the following 

IS description, assume that the first software limiters (21 a, 21b) are built in the internal control strategy 4 shown in FIG. 
1 to FIG. 5. 

[Passivity Monitor] 

20 [0053] First, the passivity monitor of the present invention will be described on the basis of FIG. 1 . The control system 

I shown in FIG. 1 is constructed of: a monitored system 2 including an existing system ex in which a user's controlled 
object 3 is controlled by an arbitrary user's control strategy 5; and a monitor system 11 including an intemal control 
strategy 4 capable of inputting a control input to the user's controlled object 3 and a passivity monitor 1 0 of a means 
for monitoring the passivity of the monitored system with the aid of an input and an output to and from the monitored 

25 system 2. An input S which the user determines to realize a target value can be Inputted from the outside to the 
user's control strategy 5 and ait)itrary feedback can be inputted to the user's control strategy 5 from the user's controlled 
object 3. An output (control input) Uu,rfrom the user's control strategy 5 and a control input Uj^^f rom the intemal control 
strategy 4 are inputted to the user's controlled object 3. An output y from the user's controlled object 3 is inputted to 
the passivity monitor 1 0 and the intemal control strategy 4. In addition, the target value input y^ can be inputted to the 

30 intemal control strategy 4. The contrDi input Uj^ from the internal control strategy 4 Is inputted to the passivity monitor 
10 and is inputted via a weight Wi^j to the user's controlled object 3. In the case of only monitoring passivity, a weight 
24b (W,nt) may be a constant. Here, by setting Wj^^ =0, it is possible to prevent the externally added monitor system 

I I from having an effect on the existing system ex. 

[0054] Moreover, the control input from the user's control strategy 5 to the user's controlled object 3 and the control 
35 input from the internal control strategy 4 to the user's controlled object 3 may be inputted to the user's controlled object 
3 by the same physical means or by different physical means, and a case where the control input is inputted to the 
user's controlled object 3 by different physical means is shown in FIG. 2. This holds for the systenns shown in FIG. 3 
to FIG. 5 and FIG. 14. 

[0055] Let* s think a robot having n degrees of freedom (having n rotary motors) as the user's controlled object 3 in 
40 FIG. 1 . Assume that the joint driving torque and the joint displacement of this robot are u (t) and q(t), respectively. Let's 
thinkofcontrollingthis robot on a target trajectory qd(t). Here, u(t), q(t), and are n-dimensional vectors, respectively 
At this time, an input to the user's controlled object 3 is the joint driving torque u(t) and the output y(t) from the user's 
controlled object 3 Is expressed by a joint angular velocity, as will be described below. The output yd(t) is a target 
trajectory of the joint angular velocity. Moreover, in the control system of the present invention, assume that all values 
4s except for time t are bounded. 



[0056] When the present invention is applied to an existing system ex constructed of the above-described user's 
controlled object 3 and a user's control strategy 5 appropriately detemnined therefor there are provided the systems 
shown in FIG. 1 to FIG. 5. or FiG. 6 and FIG. 7. in this system, the Internal control strategy 4 is defined as follows. 



>-K,y~K, II (y-y,)dt-W, y (3) 
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[0057] This becomes a Pi control strategy with respect to y. However, when thinking about q, this equation can be 
considered as a PO control strategy as shown by the following equation (4) . 



Uu'-X,iq-ti,)'K,^-W,^ (4) 
=-K,iq-gj)-KjyW,y (5) 

[0058] Hereafter, In order to simplify expression, the internal control strategy 4 is expressed by equation (5). Here. 
Ujnt is an n-dimensional vector showing a control input from the internal control strategy 4. Kp is a diagonal matrix with 
n rows and n columns showing a proportional gain with respect to q. is a diagonal matrix with n rows and n columns 
showing a differential gain with respect to q. is a diagonal matrix with n rows and n columns showing an tuning 
factor 21b (weight) of the first software limiters (21a, 21b) of the present invention built in the internal control strategy 
4. The software limiter will be described later. 

[0059] The passivity monitor provided by the present invention is such that nnonitors the accumulated energy of the 
whole monitored system 2 of an object to provide the evaluation criterion of the stability of the control system including 
the arbitrary user's control strategy 5 and arbitrary environment such as disturbance. In order to evaluate the stability 
of the control system, the present inventors have firstly found a characteristic that a passive system Is made asymp- 
totically stable by PD control and then have found that if the passivity of the monitored system 2 is satisfied, the output 
y of the system can be said to be asymptotically stable. Hence, by monitoring the passivity of the monitored system 
2. it is possible to provide the evaluation criterion of the stability of the system. 

[0060] Here, a passivity monitor 1 0 in accordance with the present Invention can be expressed as follows, 



where E shows the internal accumulated energy of the monitored system 2. From the equation (1 ) of defining passivity, 
If the following inequality is satisfied, the monitored system can be said to be passive. Eq Is the Initial internal energy 
of the monitored system appropriately detennined by the user. 

E>-Eo (7) 

[0061] Hereafter lets think the physical meaning of evaluating E by equation (7) in the passivity monitor 10 of the 
present invention. From equations (5) and (6), 



where q^ and y^ are defined as errors from the target values in the lollowing manner. 

qe = Pd-q«ye=yd-<i (9) 

[0062] Here, for convenience, when the PD control with respect to q of the intemal control strategy 4 is regarded as 
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a spring damper, the potential energy of the spring of P control is expressed by the following equation. 

^p(0 = |a/(OM,{0 (10) 

5 

[0063] From equations (8) and (1 0), equation (7) expressing the passivity of the monitored system 2 Is found to be 
equivalent to the following equation, where EpQ =^ Ep(0). 



[0064] Here, lefs think that the above-described tuning strategy 21 a of the weight W^j is detennined for an appropri- 
is ately determined constant by the following inequality (12). By thinking in this manner, even if the internal control 
strategy 4 applied to the monitored system 2 varies with time or even if an excessive target value input y^ is inputted 
at some timing to the internal control strategy 4, the first software limlter operates to Increase weight W^. thereby 
guaranteeing the stability of the output y of the monitored system 2 as Is the case where the internal control strategy 
4 does not vary with time. 

20 

0 + ^0 + J>/{^^ 9.) S E,^ + j; W.ydr (12 ) 



25 [0065] All variables except for time t are bounded and hence with the passage of time, the weight W^j that always 
satisfies the above inequality can be determined. At this time, from equations (11) and (12), the following inequality 
can be obtained. 



[0066] The first term on the left side of equation (13) is potential energy accumulated in the spring of P control at 

39 time t, and the second term is the total quantity of energy dissipated by the damper of D control. When this Inequality 
is satisfied, the energy dissipated by the damper is surely positive and monotonously increases and its upper value is 
limited by the constant Ep^ on the right side. Hence, It Is found that the potential energy of the first term on the left 
side decreases asymptotically. That is, if the monitored system 2 is monitored by the passivity monitor 10 and its 
passivity is satisfied, the inequality (13) is equivalent^ satisfied, which results in showing the asymptotic stability of 

^0 the joint displacement q. 

[0067] Therefore, if E is computed by the passivity monitor 10 and It is evaluated that the monitored system 2 is 
passive, it is found that the asymptotic stability of the output y of the monitored system 2 is also guaranteed. 
[0068] On the other hand, if the monitored system 2 is not passive, the stability of the output y of the monitored 
system 2 is not necessarily guaranteed, and it is evaluated that as the output E from the passivity monitor 10 becomes 

45 smaller, the monitored system 2 further generates energy and becomes more unstable. 

[0069] Moreover, Eq in inequality (7), which is a threshold for detennining whether the system becomes stable or 
unstable, is a value to be arbitrarily set by the user and is such a quantity having a clear physical meaning that is the 
initial internal energy of the monitored system 2, and hence can be quantitatively evaluated. Similarly, also the constant 
^pmax weight tuning strategy, expressed by inequality (12) Is such a quantity having a dear physical meaning that 

50 Is the upper limit of intemal energy of the nfionltored system 2 of PD control and hence can be quantitatively evaluated. 

[Guarantee of Stability by Software Limiter] 

[0070] Next, the guarantee of the stability of output of the monitored system by the software limiter will be described. 
55 The whole control system in which the first to fourth software limiters (21a, 21 b to 24a, 24b) are applied to the control 
system In FIG. 1 is shown separately In FIG. 6 and FIG. 7. Moreover, a control system in which not only the first software 
limiters but also the second software limiters (22a, 22b) are applied to the control system in FIG. 1 is shown in FIG. 3; 
a control system in which the third software limiters (23a, 23b) are applied to the control system in FIG. 1 is shown in 
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FIG. 4; and a control system in which the third and the fourth software limiters (23a, 23b, 24a, 24b) are applied to the 
control system in FIG. 1 is shown in FIG. 5, respectively 

[0071] The connection of the respective software limiters will be described on the basis of FIG. 6 and FIG. 7. The 
first software limiters are shown in FIG. 7 and are connected in the manner as described above. The second to fourth 

5 software limiters will be described. These also include weight tuning strategies (22a to 24a) and weights W^, Wj^gr. and 
W|ni (22b to 24b) which are detemiined and controlled by the weight tuning strategies (22a to 24a). To each of the 
weight tuning strategies (22a to 24a) is inputted the output E of the passivity monitor 1 0. To the respective weights Wy, 
Wusr. and Wfnt are inputted the output y from the user's controlled object 3, the control input Uusr ^rom the user's control 
strategy 5. and the control Input Uj^ from the Interna! control strategy 4. The output of each of the weights W^, Wu^p 

10 and Wirt 's inputted to the user's controlled object 3. Here, the output from the weight Wys, and the output from the 
weight Wj^ are inputted to the user's controlled object 3 by the same physical means as shown in FIG. 6 or by different 
physical means as shown in FIG. 3 to FIG. 5. 

[0072] In the control system 1 shown In FIG. 6 and FIG. 7, the Input u to the user's controlled object 3 Is expressed 

as follows, 

IS 

" = u„, + W,rt u,rt - Wy y + Ud,3 (14) 

where is an n-dimensional vector showing a control input from the user's control strategy 5; y is an n-dimensional 
^ vector showing an output from the monitored system 2; is an n-dimensional vector showing an input torque from 
disturbance; is the tuning factor 22b (weight) of the second software limiters (22a, 22b) of the present invention; 
Wusr 's the tuning factor 23b (weight) of the third software limiters (23a, 23b) of the present Invention; and Wj^ is the 
tuning factor 24b (weight) of the fourth software limiters (24a, 24b) of the present Invention. Each of the above Wy, 
Wusp and W,rt is a diagonal matrix with n rows and n columns and the tuning strategy of the weight W),^ Is expressed 
by the following equation. 



(15) 

where I is a unit matrix with n rows and n columns. At this time, the following equation is obtained from equations (6), 
(7). (14). and (15). 



35 



40 



45 



50 



55 



j; / Kr ( u^-u.JdT^ II dt^E, + j; / udT^ I / ydr 

(16) 

[0073] This equation is equivalent to equation (7) and hence if this inequality is satisfied, the passivity of the monitored 
system 2 is satisfied. Now, the user's controlled object 3 Is a robot and passivity holds between the input and the output 
for the robot, and hence the second temi on the right side Is limited by a lower limit as shown by inequality (1). Hence, 
even if a condition where equation (1 6) is not satisfied occurs, if a tuning strategy that makes Wys^ get asymptotically 
close to 0 is selected as the tuning strategy of the weight >N^^ and a tuning strategy that asymptotically increases 
is selected as the tuning strategy of the weight Wy. the weights and Wy that satisfy inequality (16) surely exist 
with the passage of time because all values except for time t are bounded. If these Wusr and W^ are set at the weights 
of limiters, Inequality (16) is satisfied. That is, this is equivalent to the monitored system 2 being passive. When the 
monitored system 2 is passive, as described above, the asymptotic stability of the output y of the monitored system 2 
is guaranteed by the internal control strategy 4. Therefore, it has been shown that the asymptotic stability of the output 
y of the monitored system 2 Is guaranteed by the software limiters. 

[0074] Here, this does not say that if a user's controlled object is not a user's controlled object like a robot in which 
passivity holds between the input and the output, the passivity of the monitored system is not shown, but even if a 
user's controlled object does not satisfy passivity, if inequality (1 6) can be satisfied by tuning W„„ and Wy, the passivity 
of the monitored system holds without problem. 

[0075] By updating the internal control strategy 4 and the user's control strategy 5 in the form of including Wy, W^^p 
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and W|nt (21 b to 24b), which are tuned in the above-described manner by the weight tuning strategies (21 a to 24a) of 
the software limlters, as gains, the weight tuning strategies (21a to 24a) can be used as automatic gain tuning mech- 
anisms capable of always securing asymptotic stability With this, it is possible to tune a gain appropriately without 
depending on trial and error and without causing instability. 

2. Second Embodiment 

[0076] Next, a virtual power limtter system that Is newly defined by generalizing a system including the above-de- 
scribed passivity monitor and software limlters and guarantees the stability of a control system will be described. 
[0077] First, a virtual power monitor (corresponding to the passivity monitor 1 0 of the first embodiment), which is one 
constituent element of the virtual power limiter system of the present invention, will be described. 
[0078] In FIG. 8 is shown a user's control system 2' having a virtual power monitor 1 1 0 added thereto. Assume that 
a control input from a conservative control strategy 1 04, which is designed separately from the user's control strategy 
5, is Ucav (t). The control input from the conservative control strategy 104 does not need to be necessarily inputted 
in reality to the user's controlled object 3 but is virtually connected to the user's controlled object 3. 
[0079] Here, the quantity of monitoring by the virtual power monitor 1 1 0 is defined as the following equation. 

Pv(t) = y^(t)u«^(t) (17) 

[0080] This Py is the power virtually transmitted from the conservative control strategy 1 04 to the user's control object 

3. However this power is not necessarily a physical quantity expressed by [W]. The stability of the user's control system 
2' can be evaluated from the result of monitoring of the virtual power monitor 

[0081] Moreover, a virtual power limiter (conresponding to the software limiter in the first embodiment), which Is 
another Important element constructing the virtual power limiter system of the present invention, will be described. 
[0082] In FIG. 9 is shown a conceptual diagram of a virtual power limiter system 100. A virtual power limiter 102 
tunes the user's control system 2' on the basis of the quantity of monitoring Py to thereby guarantee the stability of the 
user's control system 2'. In this embodiment, the virtual power limiter 102 is constructed of respective weights 122b, 
123b, and 124b (W^, W^^p and Vi/^) and a weight tuning strategy (conresponding to a user's control system tuning 
strategy in the drawing) 120. 

[0083] Next, it will be shown that the virtual power limiter system 1 00, which is designed as one embodiment of the 
present invention on the basis of the concept of passivity, can guarantee the stability of the user's control system 2'. 
Here, the passivity is defined by equation (1). 

[0084] First, to evaluate the stability of the user's control system 2\ let's think about the following quantity computed 
by the quantity of monitoring Py, 



EAthjlPA^)dT''ly'{t)u„{r)dT (18) 

where is energy virtually transmitted from the conservative control strategy 104 to the user's control system 2'. 
[0085] Moreover, the following inequality is introduced as the evaluation criterion of the stability of the user's control 
system 2'. Here, is an arisitrary constant previously determined. 



^.(')=i'/(0''ov(0''*-^--e^ (19) 



[0086] Here, the state where the above inequality does not hold physically means that the user's control system 2' 
generates energy and where power excessively flows out. At this time, by adopting one of strategies of 1) increasing 
the internal dissipated energy or 2) decreasing the internal generated energy for the user's control system 2', the user's 
control system 2' can be tuned in the direction in which the inequality (19) is satisfied. 

[0087] To realize the first strategy, It is thought that a tunable energy dissipating element is added to the inside of 
the user's control system 2' to increase the dissipated energy. To realize the second strategy, it is thought to decrease 
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the generated energy by making the user's control strategy 5. which has a high possibility of being an energy generating 
element, a more conservative control strategy. 

[0088] The virtual power llmiter applies the above strategy according to the quantity of monitoring to limit power 
flowing out of the user's control system 2'. If the user's control system 2' can be tuned in such a way that the inequality 
5 (1 9) is always satisfied in^espective of whether or not the control input (manipulated variable) is virtually inputted 
from the conservative control strategy 1 04, the whole system becomes a robust control system and has stability guar- 
anteed. 

[I) Case of applying the present invention to a robot control system of a user's control system] 

10 

[0089] An example of applying the virtual power limiter system 1 00 of the present invention to a robot control system 
will be described. FIG. 9 shown above is a block diagram showing its configuration example. Here, assume that the 
detail of the user's control strategy 5 and the dynamic characteristics of robot hardware as the user's controlled object 
3 are unknown. However, assume that each joint velocity y(t) of the robot can be measured by a sensor and that a 
'5 control input u^sr (t) from the user's control strategy to each corresponding joint actuator can be tuned. Here, y and 
u^y are a conjugate pair. 

[0090] A driving force u actually applied to the robot hardware is as follows, 

20 " = W„,r"«.r + "<fc+W^"csv + W^Uv (20) 

where is an unknown input such as disturbance, u^lt) = -K^ y (t) is a negative output feedback connected to the 
user's controlled object, and Ky is a positive diagonal matrix of Its gain. 

[0091] By the way, although equation (20) corresponds to equation (14), when compared with each other, both equa- 
tions are different from each other in expression relating to the weight W^. This is because the elements of the above- 
described matrix Ky of the gain are already Included In the weight In the expression by equation (14), whereas the 
elements of the matrix Ky of gain are not included in the weight Wy in the expression by equation (20), that Is, the 
elements of the matrix Ky are separated from the weight Wy as shown by Uy(t) = -Ky y(t). 

[0092] Therefore, in FIG. 3 and FIG. 6 ishowing the first embodiment of the present invention, only the block 22b of 
the weight Wy is shown at the point of negative output feedback connected between the input and the output of the 
user's controlled object, whereas in FIGs. 9 to 16 showing the second embodiment of the present invention, not only 
the block 122b of the weight Wy but also the block 122c of the gain -Ky of the negative output feedback is shown at 
the point of negative output feedback connected between the input and the output of the user's controlled object. 
[0093] Here, each of Wusr(Pv). ^taiJPy^ ^^d Wy(Py) is a positive diagonal matrix expressing a variable weight con- 
structing a virtual power limiter. The diagonal elements of W^^, W^sy are not less than 0 and not more than 1 and W^ 
= i • Wusr, where I is a unit matrix. 

[0094] As the conservative control strategy 1 04, for example, the following each shaft PD control is selected, 

40 Ucsv^-'Srt-Pdj-Kdy (21) 

where Kp and K^ are positive diagonal matrixes and q^ Is the target value command of each joint displacement and Is 

fundamentally made to agree with a target value command to the user's control strategy. 

[0095] At this time, from equation (20), the evaluation criterion (19) of stability becomes equivalent to the following 

inequality. 



(22) 

[0096] From the above inequality, It is found that when a state where inequality (19) is not satisfied is detected by 
monitoring Py, by bringing Wusr close to 0 and by increasing Wy, the user's control system 2' can be tuned In a such 
way that inequality (19) is satisfied. 
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[0097] If inequality (19) is always satisfied by suppressing the effect y^u^ of unknown disturbance and the effect 
y"'"u of unknown dynamic characteristics of the robot hardware, the dissipation of output of the whole system is shown 
by each shaft PD control strategy (21) and the stability of the unknown robot control system can be guaranteed. 

[ii) Case of applying the present invention to power assist system) 

[0098] Moreover, an example wilt be described in which the virtual power limlter system of the present invention is 
applied to a power assist system (corresponding to the above-described user's control system 2') tor assisting human 
power by the use of the same robot as described above. It is said that the conventionally known power assist system 
is generally hard to guarantee stability because an unknown dynamic characteristic of a human is included In a feedback 
loop. However if the present invention is applied to the power assist system, in spite of the fact that the dynamic 
characteristics of the human is unknown, it is possible to restrict power flowing out to the human from the power assist 
system and hence to secure safety for the human by a virtual power limiter. 

[0099] FIG. 1 0 is a block diagram showing one example to which the virtual power limiter system 1 00 of the present 
invention Is applied to a power assist system 150. 

[01 00] When the present invention is applied to the power assist system 1 50, the operating force of the human shown 
in the following is used as the conservative control strategy 104. 

"c«. = "h (23) 

[0101] This is an operating force applied directly to a power assist robot 1 03 (corresponding to the above-described 
user's controlled object 3) by the human. Since the human (operator H) is connected mechanically directly to the power 
assist robot 1 03, virtual connection is not applicable and hence the weight of the virtual power limiter W^^ = i. In this 
embodiment, assume that the simplest power assist control strategy, as shown In the following, is used for the user's 
control strategy (corresponding to 111 In FIG. 10, hereafter referred to as "power assist control strategy" In the case 
where the present invention is applied to the power assist system 150). Other higher power assist control strategy may 
be used. 

•Jusr = K^^Uh (24) 

where Kyg, is a positive diagonal matrix expressing a power assist gain. By substituting these into equation (20), the 
driving force applied to the power assist robot 103 is expressed by the following equation. 

" = "h K,3, Uh + Uji, + (25) 

[0102] From this equation (25), the evaluation criterion (1 9) of stability becomes equivalent to the following equation. 



[01 03] Therefore, it is clear that also in the case of the power assist system, by bringing the weight W^sr of the virtual 
power limiter close to 0 and by increasing W^, the power assist system can be tuned so that equation (1 9) is satisfied. 
This corresponds to the realization of automatic gain tuning of preventing power assist from being unstable by the 
virtual power iimiter system 100. 

[0104] In this manner, according to the present embodiment, it is possible to limit power flowing out to the human 
(operator H) from the power assist system 150 irrespective of human dynamic characteristics being unknown and 
hence to secure safety to the human by the virtual power limiter. 

[0105] In this regard, In the respective examples of the above-described embodiments i) and ii), even if the passivity 
of the robot hardware (3, 1 03) is not necessarily supposed, when the virtual power limiter system 100 is designed on 
the basis of the concept of passivity, if only inequality (22) and inequality (26) are satisfied by tuning variable weights 
1 22b . 1 23b, and 1 24b (Wy, Wusr. Wcsy, here, In the case of power assist system 1 50, W^sy = t). ft is possible to guarantee 
stability also for user's controlled object which is not passive. 
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[0106] Here, assume that when the virtual power limiter system 100 of the present invention is applied to the user* 
s control system as shown in FIG. 9, the tuning strategy of the respective weights Is a user's control system tuning 
strategy 120 and that when the virtual power limiter system 100 of the present invention Is applied to the power assist 
system as shown in FIG. 10» the weight tuning strategy of the respective weights is a power assist system tuning 

s strategy 120'. 

Embodiment 1 

[Various user's control systems to which the virtual power limiter system Is applied] 

10 

[0107] Hereafter, one embodiment of the present invention wilt be described with reference to the accompanying 

drawings. 

[0108] Here, In the descriptions of the respective following examples, the same parts as in FiG. 1 to FIG. 10 are 
denoted by the same reference symbols and the like. 

15 

[First Example] 
Basic Application 

20 [0109] FIG. 11 Is a block diagram showing one example of a motor control system to which the virtual power limiter 
system of the present invention Is applied. FIG. 12 is a block diagram showing one example of a pneumatic cylinder 
system to which the virtual power limiter system of the present invention is applied. 

[0110] A motor control system 40 shown in FiG. 11 includes: a motor M and a motor driver MD, which become the 
user's controlled object 3; a controller C which is open to the user and is used for inputting a command from the user's 
25 control strategy 5 to the motor M; andthe virtual power limiter system 100 of the present invention. Here, a commercially 
available motor driver can be appropriately used as the motor driver MD. 

[01 1 1 ] The virtual power limiter system 1 00 includes a virtual power monitor system 1 01 and a virtual power limiter 
102 and is constructed in the form of hardware made of an analog or digital electronic circuit, in the form of software 
including a program stored in an arithmetic unit of a microcomputer or the like: or In the forni of combination of these. 

30 [01 1 2] The system configuration and the other details of the virtual power limiter system 1 00 are the same as those 
described on the basis of FIG. B and FIG 9 in the second embodiment I). To the user's control strategy 5 in the controller 
C are Inputted an arbitrary input S from the user and an arbitrary feedback tram the output of the motor M. Moreover, 
to the virtual power limiter system 1 00 are inputted the user torque command u^^^ from the user's control strategy 5, 
the input y^j to the conservative control strategy 104, and the output infomnation y of the motor M. A torque command 

35 u is inputted to the user's controlled object 3 from the virtual power limiter system 100. In this example, the output 
information y of the motor M is the angular velocity of the motor and infomiation obtained by an angular velocity sensor 
108 using a publicly known encoder, tachometer or the like is fed back to the virtual power monitor system 101 and 
the virtual power limiter 1 02. Moreover, in this example, the Input y^ to the conservative control strategy 1 04 is a target 
angular velocity. 

40 [01 1 3] The virtual power limiter 1 02 includes the user's control system tuning strategy 1 20 and the weights 1 22b to 
124b (Wy, Wygp and W^sv) tuned by the user's control system tuning strategy 120. Moreover, the user's control system 
tuning strategy 120 is connected to the output of the virtual power monitor 110. To the weights 122b to 124b (W^,, 
Wjjsr. and Wgsy) are inputted the output y of an object to be tuned, the user torque command u^sr^rom the user's control 
strategy 5, and the control input u^sv from the consen/ative control strategy 104. 

45 [0114] The configuration of a pneumatic cylinder system 80 shown in FIG. 12 is also the same as that of a motor 
control system 40 shown in FiG. 11. Here, the user's controlled object 3 is a pneumatic cylinder AC and respective 
commands are pressure commands. Positive or negative pressure proportional to a pressure command value (current) 
is applied to the pneumatic cylinder AC from a valve V1 to extend or contract a piston P. 

[01 1 5] In this example, the output Information y of the pneumatic cylinder AC is the volume change velocity AV of 
so the cylinder and the Infomiation of the volume change velocity AV is appropriately fed back to the virtual power monitor 
system 1 01 and the virtual power limiter 1 02 by a sensor 1 07. Moreover, in this example, the input y^ to the conservative 
control strategy 104 is a target volume change velocity. 

[0116] Next, the operation of the motor control system 40 In accordance with this example will be described with 
reference to FIG. 11. 

ss [0117] First, the user Inputs a control input (arbitrary input S), for example, relating to the angular velocity of the 
motor with time on a horizontal axis fromi the controller C. Usually, if the user's control system 2' is in a stable state, 
the user torque command u^sr by the user's control strategy 5, which is cutputted from the controHer C, is applied as 
an input to the user's controlled object 3 (torque command) u = u^s^ to the motor driver MD without being subjected to 
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a new processing in the virtual power llmiter system 100, whereby the motor M is controlled and operated. At this time, 
the weight 123b (W^sr) of the virtual power Itmiter 102 is W^sr = 1- In this manner, if the stability of the user's control 
system 2' is held only by Uygp the control input Ugg^ from the conservative control strategy 1 04 is not necessarily inputted 
to the motor M. Therefore, if the input u^s, by the user* control strategy 5 does not need the control input u^J^1ro^\ the 

s conservative control strategy 1 04 and the user's control system 2' is stable, the role of the consen^ative control strategy 
1 04 can be limited to inputting the control Input u^^g^ to the virtual power monitor 1 1 0 by setting the weight 1 24b (Wg^y) 
to 0. Even in this case, the output information y of the motor M and the control input u^y from the conservative control 
strategy 1 04 are inputted to the virtual power monitor 110 and the virtual power monitor 110 keeps monitoring the 
stability of the user's control system 2'. 

10 [0118] On the other hand, when the user's control system 2* becomes unstable, if the virtual power llmiter 1 02 Is 
appropriately operated, the output y of the user's control system 2' can be made asymptotically stable. In response to 
the output Py of the virtual power monitor 110, the virtual power llmiter 1 02 operates the user's control system tuning 
strategy 120 connected to the virtual power monitor 110 and then detennine the respective weights 122b to 124b (Wy, 
Wysp and Wcsv) to make the output y of the user's control system 2' stable while keeping control. 

IS [01 19] In this manner, according to the motor controlsystem 40 in accordance with the present invention, it is possible 
to always guarantee the asymptotical stability of the output y of the user's control system 2'. 

[Second Example] 

20 Applications to electric/electronic control system 

[0120] FIG. 13 shows one example to which the present invention is applied to an electric/electronic control system. 
The electric/electronic control system is not necessarily limited to a system for controlling a rotary electric machine as 
shown in the first example, but can be assumed to be other various systems such as a power supply system for 

25 communications, 

[0121] An electric/electronic control system 50 in accordance with this second example includes: an electric/elec- 
tronk; controlled object EE to become the user's controlled object 3; a controller C whch is open to the user and is 
used for inputting a command from the user's control strategy 5 to the electric/electronic controlled object EE; and the 
virtual power llmiter system 1 00 of the present invention. The electrto/electronte controlled object EE Includes a control 
30 voltage sounse VS, an ammeter AM, and a desired load R. The virtual power llmiter system 100 Includes the virtual 
power monitor 1 01 and the virtual power limiter 1 02 and, as is thecase with the first example, is constructed of hardware, 
software, or a combination of them. 

[0122] The basic configuration and operation of the electric/electronic control system 50 In accordance with the 
second example is the same as those of the motor control system 40 in the first example. 

35 [0123] The control voltage source VS is controlled according to an input (voltage command) u to the user's controlled 
object 3 from the virtual power limiter system 1 00 to tune cun-ent passing through the desired load R. Current y passing 
through the desired load R is detected by the ammeter Al\^ or a shunt resistance and Is Inputted to the gain 122c (*Ky} 
of the negative output feedback, the conservative control strategy. 1 04, and the virtual power monitor 110 In the virtual 
power limiter system 1 00. At the same time, the virtual power monlor system 110 has also inputted the control input 

40 from the consen/atlve control strategy 1 04 and monitors the stability of the user's control system 2' by the use of 
y and u^^, 

[0124] To the user's control strategy 5 in the controller C are inputted an arbitrary input S from the user and an 
arbitrary feedback from the output of the electnc/etectronic controlled object EE. Moreover, to the virtual power limiter 
system 100 are inputted the user's voltage command u^J^ from the user's control strategy 5, the input y^ to the con- 
45 sen/ative control strategy 104, and the output Infonnation y of the electric/electronic controlled object EE. Moreover, 
In this example, the input y^ to the conservative control strategy 1 04 is a target cunrent. The target cun^nt value is, for 
example, a rated cunrent value. 

[0125] Next, the operation of the electric/electronic control system 50 in accordance with this second example will 
be described with reference to FIG. 13. 

so [0126] Usually, If the electric/electronic control system 50 is in a stable state, the user's voltage command u^g^ from 
the controller C is inputted to the control voltage source VS as a voltage command u = u^^^ to the user's controlled 
object 3 without being subjected to any new processing in the virtual power limiter system 100, whereby the electric/ 
electronic controlled object EE is controlled. That is, when a current output passing through the desired load R is not 
sufficient, the user's voltage command u^^^J Is increased by the feedback control between the user's control strategy 6 

S5 and the electric/electronic controlled object E E to increase the voltage command u to the electric/electronic controlled 
object EE to Increase the current output, whereas when a current output is excessive, the user's voltage command 
Uusr is decreased to decrease the voltage command u to the electric/electronic controlled object EE to decrease the 
cunrent output. 
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[0127] On the other hand, when the user's control system 2' becomes unstable, if the virtual power limiter 102 is 
appropriately operated, the output y of the user's control system 2' car) be made asymptotically stable. In response to 
the output Py of the virtual power monitor 110, the virtual power limiter 102 operates the user's control system tuning 
strategy 1 20 connected to the virtual power monitor 1 1 0 and then detemiine the respective weights 1 22b to 1 24b (W^ , 
s Wusr, and W^sv) to make the output y of the user's control system 2' stable while keeping control. Here, the user's 
control system tuning strategy 120 Is a tuning strategy of the respective weights of the virtual power limiter 1 02. 
[0128] In this manner, according to the electric/electronic control system 50 in accordance with the present invention, 
it is possible to always guarantee the asymptotical stability of the output y of the user's control system 2\ 

10 [Third Example] 

[Case where some control inputs to be Inputted to the user's controlled object are inputted by different physical means] 

[0129] A motor control system 60 in accordance with this example Is a system in which to brake or assist a main 
IS motor MM, a secondary motor SM physically connected to the output shaft of the main motor MM via torque transmitting 
means and a secondary motor driver SD electrically connected to the secondary motor SM are added to the motor 
control system in the first example. Here, in this example, the secondary motor SM and the secondary motor driver 
SD construct part of the virtual power limiter 102. Hereafter, FIG. 14 will be mainly described. 

20 Configuration 

[0130] FIG. 1 4 is a block diagram showing one example of the motor control system to which some control inputs 
are inputted to the user's controlled object 3 by different physical means. Also the motor control system 60 in accordance 
with this example, as is the case with the motor control system 40 In accordance with the first example, includes: the 
25 main motor MM and the main motor driver MD, which become the user's controlled object 3; the controller C which is 
open to the user and is used for inputting a command from the user's control strategy 5 to the main motor MM; and 
the virtual power limiter system 100 of the present invention. 

[0131 ] The virtual power limiter system 1 00. as is the cases with the respective examples, includes the virtual power 
monitor system 1 01 and the virtual power limiter 1 02. In the case of this example, the virtual power limiter 1 02 includes: 

30 the user's control system tuning strategy 120 connected to the virtual power monitor 110 and the respective weights 
122b and 124b (Wy, \N^) connected to this virtual power monitor 110. the secondary motor SM, and the secondary 
motor driver SD. To the user's control strategy 5 in the controller C are inputted an arbitrary input S from the user and 
an arbitrary feedback from the output of the main motor MM. To the virtual power limiter system 1 00 are inputted an 
Input y^ to the conservative control strategy 1 04 and the output infonnatlon y of the main motor MM. In this example, 

35 the input y^ to the conservative control strategy 104 is a target angular velocity. 

[0132] In the first example and the second example, as Is clear by referring to FIG. 11 to RG. 13, the control Input 
u^sr to the user's controlled object 3 from the user's control strategy 5 and the control Input u^s^ to the user's controlled 
object 3 from the conservative control strategy 104 are processed in the virtual power limiter 102 before they are 
inputted to the user's controlled object 3 and hence one command value is inputted to the user's controlled object 3. 

40 Therefore, the control input from the conservative control strategy 104 and the control input from the user's control 
strategy 5 are inputted to the user's controlled object 3 by the same physical means. 

[0133] On the other hand, in this example, the control input from the consenrative control strategy 1 04 and the control 
input from the user's control strategy 5 are Inputted to the user's controlled object 3 by different physical means, as 
wilt be described below. 
45 [0134] That is, 

i) the control input u^g^ is directly inputted from the user's control strategy 5 to the main motor driver MD of the 
main motor MM, which is the user's conlrolied object 3, 

ii) whereas the control input u^sv is subjected to weight 124b {V\fcsv) and then is combined with of a signal from 
50 another weight 122b (WJ (negative feedback signal of the output y from the user's control system 2') and is inputted 

in the form this combined signal (secondary motor torque command) u' to the secondary motor driver SD of the 
secondary motor SM different from the main motor MM. This secondary motor torque command u' is converted to 
a mechanical control input u via the secondary motor driver SD and the secondary motor SM and then is inputted 
to the output shaft side of the main motor MM of the user's controlled object 3 via mechanical means like torque 
55 transmitting means T. 

[0135] In this manner, in this example, the control Input from the conservative control strategy 1 04 and the control 
input from the user's control strategy 5 are inputted to the user's controlled object 3 by different physical means. 
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[0136] Moreover, in this example, 1) the signal of the output y from the user's controlled object 3 is taken out of the 
rotary shaft side of the secondary motor SM, which is mechanically coupled to the output shaft of the main motor iVIM 
via the torque transmitting means T and is rotated at the number of revolutions con-esponding to the number of revo- 
lutions of the output shaft of the main motor MM. 
s [01 37) Moreover in this example, 2) the weight Wyg, of the virtual power limiter provided between the user's control 
strategy 5 and the user's controlled object 3 is omitted. 

[0138] In this manner, In this example, an electrical direct connection does not exist between the user's controlled 
object 3 and the virtual power limiter system 100, but only a mechanical connection including the secondary motor 
driver SD, the secondary motor SM, and the torque transmitting means T exist between them. 

10 

Operation 

[01 39] Hereafter the operation of the motor control system 60 in accordance with this third example will be described. 
[0140] First, the operation and action of the secondary motor SM will be described. 

« [0141] The secondary motor SM can brake the main motor MM and can function as the main motor MM in place of 
it under conditions where the main motor MM has its motion limited by some circumstances. 
[0142] In the case of braking the main motor MM, for example, the value of the output y of the user* s control system 
2' Is measured and, if necessary, a control input produced by subjecting the output y of the user's control system 2' to 
a negative feedback (the gain 1 22c (- K^) of a negative output feedback) and the weight Wy is combined with the control 

20 input Ucsv. which Is outputted from the conservative control strategy 1 04 and is subjected to the weight to obtain 
a secondary motor torque command u' and then the obtained secondary motor torque command u* is inputted to the 
secondary motor driver SD. Then, torque in the direction opposite to the rotational direction of the main motor MM is 
applied to the output shaft of the main motor MM from the secondary motor SM on the basis of the secondary motor 
torque command u' to apply mechanical braking to the main motor MM. 

25 [0143] On the other hand, the control input u^^^ from the conservative control strategy 1 04 is also inputted (in the 
form of the secondary motor torque command u*) to the secondary motor driver SD. Hence, for example, under the 
conditions where an internal factor or an external factor causes some trouble in the main motor MM to stop the main 
motor MM, a main control strategy Is shifted from the user's control strategy 5 to the conservative control strategy 1 04 
to drive the secondary motor SM on the basis of the conseivatlve control strategy 1 04 to make the secondary motor 

30 SM temporarily alternatively perform a function to be performed by the main motor MM . 

[0144] The main motor MM and the secondary motor SM are physically connected to each other by a torque trans- 
mitting means T made of. for example, a chain and torque can be transmitted between them. In this example, the 
secondary motor driver SD drives the secondary motor SM on the basis of the secondary motor torque command u'. 
For example, according to the inputted secondary motor torque command u', 1) torque in a direction opposite to the 

35 rotational direction of the main motor MM is applied to the secondary motor SM to brake the rotation of the main motor 
MM; or 2) on the basis of the conservative control strategy 104. the secondary motor SM can act as the main motor 
MM in place of it under conditions where the main motor MM has its rotation limited. 

[0145] Next, the operation of the whole motor control system 60 In accordance with this third example will be de- 
scribed with reference to FIG. 14. 

^0 [0146] Usually, if the user's control system 2' is in a stable state, the main motor MM Is controlled and operated on 
the basis of the user's torque command u^^^ outputted from the controller C. If the stability of the user's control system 
2' is kept only by the u^^p the control input u^ from the conservative control strategy 104 is not necessarily inputted 
to the main motor MM via the secondary motor SM. Hence, if the user's torque command u^sr by the user's control 
strategy 5 does not need the control Input u^sv from the consen^ative control strategy 1 04 and the user's control system 

45 2' is in the stable state, the role of the conservative control strategy 1 04 can be limited to the inputting of the control 
input Ucsv to the virtual power monitor 11 0 by setting the weight 1 24b (W^^) = 0. Even in this case, the output information 
y of the main motor MM and the control Input u^^^ from the consewative control strategy 1 04 are inputted to the virtual 
power monitor 110 and the virtual power monitor 110 keeps monitoring the stability of the user's control system 2'. 
[01 47] On the other hand, when the user's control system 2' is brought to an unstable state, the user's control system 

so tuning strategy 1 20 and the respective weights 1 22b, 1 24b (W^. W^sv) connected to It are appropriately operated and 
the secondary motor torque command u' is inputted to the secondary motor driver SD to operate the secondary motor 
SM. With this, for example, 1 ) torque In the direction opposite to the rotational direction of the main motor MM is applied 
to the output shaft of the main motor MM via the torque transmitting means T, or 2) under conditions where the main 
motor MM has its rotation limited, the secondary motor SM is driven on the basis of the conservative control strategy 

55 104 in such a way as to act as the main niotor MM in place of it, whereby the output y of the user's control system 2' 
can be made asymptotically stable. In response to the output Py of the virtual power monitor 110, the virtual power 
limiter 1 02 operates the user's control system tuning strategy 120 connected to the virtual power monitor 1 10 and then 
determine the weights 122b and 124b (W^, \N^) to make the output y of the user's control system 2' stable while 
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keeping control. 

[0148] In this manner, according to the motor control system 60 In accordance with this example, it is possible to 
always guarantee the asymptotical stability of the output y of the user's control system 2'. by the action of the virtual 
power llmlter system 100. 

5 

[Fourth Embodiment] 
Application to robot system 

10 [0149] Next, an example in which the virtual power llmlter system of the present Invention is applied to a robot system 
having a plurality of joints and having motors RM1 to RM3 at the respective joints will be described as an example for 
controlling a plurality of motor systems by mainly referring to FIG. 15. Such a robot system can be practically applied 
to, for example, automobile assembling robots and welding robots. As shown in FIG. 15, a robot system 70 in accord- 
ance with this fourth example includes a robot arm RA to become the user's controlled object 3, the controller C that 

IS is open to the user and is used for inputting the user's command from the user's control strategy 5 to the robot arm 
RA, and the virtual power limlter system 100 of the present invention. 

[0150] The virtual power limiter system 100 Includes the virtual power monitor system 101 and the virtual power 
limiter 102 and is constructed in the form of hardware made of an analog or digital electronic circuit, In the form of 
software of a program stored in an arithmetic unit of a microcomputer or the like, or in the form of the combination of 
20 them. 

[0151] Moreover, the robot ann RA Includes the driving motors RM1 to RMSforthe respective joints and motor drivers 
MD1 to MD3 that receive a torque command vector u from the virtual power limiter system 1 00 and drive these motors. 
Hence, in this example, u, y, y^, and the like shown in FIG. 15 are three-dimensional vectors for the respective 
motors. Here, the input y^j to the conservative strategy 104 is a target angular velocity. 

25 [0152] The basic configuration and operation of the internal control block of a robot system 70 in accordance with 
this fourth example is the same as that of the motor control system 40 in the first example, but this fourth example is 
different in that one virtual power limiter s;ystem 100 controls three motors RM1 to RM3. That is. a torque command u 
to the users controlled object 3 or the output Information y (angular velocity output) from the user's controlled object 
3 is inputted to the motor drivers MD1 to MD3 or outputted from the motors RM1 to RMS, respectively, and the respective 

30 weights 1 22b to 1 24b (W^, W^s,, and W^sv) of the virtual power limiter 1 02 are not scalars but diagonal matrixes . Here, 
the weight 122b (WJ is a diagonal matrix = diag {W^i) (Wy, > 0). the weight 123b {^N^,^,) is a diagonal matrix Wu„ 
= diag {)N^^^) (0 < \N^^,^ <1 ) . and the weight 1 24b i}N^) is a diagonal matrix = diag(Wcsvi) (0 ^ W^avi <1 )• 
[0153] Hereafter, the operation of the robot system 70 in accordance with this fourth example will be described. First, 
one virtual power monitor 110 is provided and monitors power virtually transmitted from the conservative control 

35 strategy 1 04 to the user's controlled object 3 to evaluate and analyze the stability of the output y of the user's control 
system 2'. To the virtual power monitor 11 0 are inputted the control input from the conservative strategy 104 and 
the output infomiatlon y from the respective motors {RM1 to RM3). 

[0154] Usually, if the user's control system 2' Is in a stable state, the Input Uu„ from the user's corttrol strategy 5 
given by the controller C is directly inputted to the respective motor drivers MD1 to MD3 as the torque command u = 

40 u^^ to the user's controlled object 3 for the respective motors RM 1 to RMS without being subjected to any new process- 
ing in the virtual power limiter system 100, whereby the respective motor RM1 to RMS are controlled and operated. At 
this time, the weight 1 23b (W^sr) of the virtual power limiter 1 02 is W^g^ = 1 ■ In this manner, If the stability of the user's 
control system 2' is kept only by the Uygp the control input Ugs^ from the conservative control strategy 104 is not nec- 
essarily inputted to the user's controlled object 3. Hence, if the control input from the user's control strategy 5 does 

^5 not need the control input from the conservative control strategy 1 04 and if the user's control system 2' is in the 
stable state, the role of the conservative control strategy 1 04 can be limited to the inputting of the control input Uggv to 
the virtual power monitor 11 0 by setting the weight 124b (Wpgy) = 0. 

[01 55] On the other hand, when the user's control system 2' is brought to an unstable state, if the virtual power limiter 
102 Is appropriately operated, the output y of the user's control system 2' can be made asymptotically stable. At this 

so time, since the respertive weights 122b to 124b {Wy, W^sr. and W^v) of the virtual power limiter 102 are matrixes, it 
is possible to independently apply weights to three motors RM1 to RMS, respectively. Hence, in this robot system 70, 
It is possible to detennine the stability of the user's control system 2" as a whole by one virtual power monitor 1 1 0 and 
to change the degrees of limitation of energy of the respective controlled objects (three motors) of the user's controlled 
object 3, respectively. For example, it is also possible to make a tuning of setting only the weight of the motor RM1 

ss close to the hand of the robot at a larger weight to minimize the fluctuations of the hand. 

[0156] In this manner, according to this fourth example, it is possible to finely control the stability of the output y of 
the user's control system 2' including the plurality of motors. That Is, since the respective weights 122b to 124b (Wy, 
\N^^^, and \N^) of the virtual power llmlter 1 02 are not scalars but are expressed by matrixes, It is possible to set 
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independent limitersfor respective degrees of freedom (respective motors) and to perfomi appropriate control respon- 
sive to the situations of the respective motors. 

Embodiment 2 

5 

[Power assist robot to which the virtual power limiter system is applied] 

[01 57] Hereafter, a case where the virtual power limiter system of the present Invention is applied to a power assist 
system constructed on the basis of the robot system shown in FIG. 15 will be described as an example In which the 
10 virtual power limiter system of the present invention Is applied to a power assist system. TTie following description will 
be provided on the basis of FIG, 16. 

[0158] As shown in FIG. 1 6. the basic configuration of a power assist robot 103 of this embodiment 2 is the same 
as that of the user's controlled object 3 in accordance with the robot system 70 shown in FIG. 15, but is different in 
that the hand of the robot arm RA is directly operated by an operator H and in that its operation is assisted by the 

15 motors RM1 to RM3 arranged at the respective joints of the robot anm RA, 

[0159] By the way in the respective examples in the foregoing embodiment 1 , in the case where the virtual power 
timiter system 100 of the present invention is applied to the user's control system 2', when the virtual power limiter 1 02 
is designed, the conservative control strategy 104 is previously prepared by the use of calculation or the like. 
[0160] On the other hand, in the power assist system 1 50 like this embodiment 2, the power assist robot 1 03 corre- 

20 spending to the user's controlled object and the human of the operator H are mechantoally connected to each other 
and a force sensor 109 is provided between both of them. Hence, when the virtual power limiter system 1 00 of the 
present invention is applied to the power assist system 150, by utilizing this force sensor 1 09 and by using the meas- 
urement value Uf, of this force sensor 109, the operation of the human can be regarded as the above-described con- 
servative control strategy. 

25 [0161] In this embodiment 2, as shown in FIG. 16, by using the measurement value U)^ (vector value) of a force 
applied to the robot RA by the operator H, which is obtained from the force sensor 109, the operation of the operator 
H is treated as a consen/ative control strategy. 

[0162] Here, the configuration of the whole power assist system 150 is the same as shown in FIG. 10. In this em- 
bodiment 2, the magnitude of the force u^ when the hand of the robot arm RA is operated by the operator H is detected 
30 by the force sensor 1 09 and the force u^ is inputted to the power assist robot 103, the virtual power monitor 1 1 0, and 

the power assist control strategy 111 . 

[0163] Next, the action of the power assist robot 103 of this embodiment 2 wili be described. 

[0164] First, in the power assist robot 1 03 of this embodiment 2. a user assist torque command value is detemained 

on the basis of the force u^ applied to the robot arm RA by the operator H, the value of an angular velocity y. and the 

35 power assist control strategy K^sp With this, a torque command u is actually inputted to the respective motor drivers 
MD1 to MD3 and the motors RM1 to RM3 and as a result, a driving force is applied to each of the motors RM1 to RM3 
to assist the operation of the operator H. Other details are the same as those described in the second embodiment ii). 
[0165] According to this embodiment 2, It is possible to limit power flowing out from the power assist robot 1 03 to 
the operator H irrespective of the dynamk: characteristk^s of the operator H being unknown and hence to secure the 

40 safety of the operator H by the virtual power limiters 1 22b and 1 23b (\N^^ and W J . 

[0166] In this regard, the present invention is not necessarily limited to the configuration described in the respective 
above embodiments but can be variously changed in design and be modified in other ways. 
[0167] For example, in the example relating to the motor control system and the robot system shown in FiG. 11 and 
the other drawings, the target value input y^ to the conservative control strategy 104 is the angular velocity Input, but 

45 the target value input y^ may be, for example, a target value relating the rotational angle of the motor M or the like. 
Simiiaiiy, In the example relating to the pneumatic cylinder shown in FIG. 12, thetargetvalueinputy^ to the conservative 
control strategy 1 04 is the volume change velocity, but the target value Input y^ may be, for example, a physical quantity 
such as the rate of flow of air. 

[0168] Moreover, the target value input y^ is not necessarily set by the user, but It is also recommended that a fixed 
so value be previously set as a desired fixed value In the conservative control strategy 104: for example, In the case of 
the current input shown in FIG. 13, a rated current or a zero current may be set, and in the case of the angular velocity 
input shown in FIG. 11 and the other drawings, a zero velocity may be set. 

[0169] Further, the control command inputted to the conservative control strategy may be the same as the control 
command to be inputted to the user's control strategy but, for example, a command having a different unit and a different 
S5 physical quantity may be inputted to the conservative control strategy 

[01 70] Still further, the control command inputted to the consen/ative control strategy may be a more conservative 
control command as compared with the control command (arbitrary input S) to be inputted to the user's control strategy. 
[0171] As to the more consen/ative control command like this, for example, if a target value input to be inputted to 
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the conservative control strategy is a current input shown in FIG. 1 3, a command such as the above-described "rated 
current" and "zero current " may be used, whereas if a target value input to be inputted to the conservative control 
strategy is an angular velocity input shown in FIG. 11 and the other drawings, a command of "zero velocity" may be used. 
[0172] In the configuration example shown in FIG. 1 3, the voltage applied from the control voltage source VS to the 
5 desired load R may be measured and displayed by a volt meter VM. Further, when the main motor MM is braked in 
the configuration example shown in FIG. 14, it is also recommended that the secondary motor SM be made a rotary 
electric machine to become also a generator and that the secondary motor driver SD be made, for example, a unit 
con^esponding to an electronic load, and that the quantity of consumption of generated power obtained from both 
terminals of the secondary motor SM is tuned by changing the magnitude of the load to thereby perform the angular 
velocity control of the main motor MM. Still further, in the configuration example shown In FIG. 14. needless to say. not 
only the chain but also a belt, a gear or the like can be used as the torque transmitting means T. 

INDUSTRIAL APPLICABILITY 

'5 [0173] The virtual power limiter system in accordance with the present invention can guarantee the stability of the 
output of the user's control system no matter what machine system and the like is an object, no matter what the 
environment of the machine system and the like is installed In, and no matter what control strategy is used by the user. 
For example, think a case where the virtual power limiter system of the present invention is applied to the robot arm, 
and assume that when a command of lifting an arm is issued, the arm becomes unstable and starts to vibrate. The 

20 conventional hardware limiter shuts current or brakes and hence the arm jerkily drops down or is fixed there. However, 
If the virtual power limiter system of the present invention is applied to the case, it is possible to keep an operation of 
lifting the ami while interrupting the unstable action. Hence, the virtual power limiter system of the present invention 
can be most suitably applied to machines of which particularly high control performance and sufficient stability and 
safety are required at the same time, for example, industrial robots, space robots, or electrically operated power steering 

25 gears, and further, power assist systems typified by a power assist robot or a power assist wheel chair. Moreover, the 
virtual power limiter system of the present Invention can be constructed as software made of a program stored in the 
arithmetic unit of the microcomputer or the like and as hardware made of analog or digital circuits. 
[0174] As described above in detail, it is clear that the present invention is a new and extremely useful invention to 
provide a system configuration that can evaluate the stability of the output of a user's control system including unknown 

30 dynamk; characteristtes and all effects of disturbances and can guarantee the stability of the output of the user's control 
system irrespective of the unknown dynamic characteristics and the disturbances. 
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Claims 



1. A control system characterized in that in the user's control system having a user's controlled object controlled 
30 by a user's control strategy, the control system comprises: a conservative control strategy, which receives a feed- 
back signal from the user's controlled object and can input a control input to the user's controlled object; and a 
virtual power monitor that monitors power virtually transmitted from the conservative control strategy to the user's 
controlled object, and can evaluate and analyze stability of an output from the user's control system. 

35 2. The control system as claimed In claim 1 , characterized In that the control system further comprises a virtual 
power ilmlter, which tunes the quantity of negative feedback from the output from the user's control system to an 
input to the user's controlled object In the user's control system on the basis of monitoring of virtual power In the 
virtual power monitor to limit outflow of the vlitual power from the user's control system to a virtual power monitor 
system, and thereby guarantees stability of the output from the user's control system. 

40 

3. The control system as claimed in claim 1 or claim 2, characterized in that the control system further comprises 
a virtual power limiter, which tunes a control input from the user's control strategy to the user's controlled object 
in the user's control system on the basis of monitoring of virtual power in the virtual power monitor to limit outflow 
of the virtual power from the user's control system to a virtual power monitor system, and thereby guarantees 

45 Stability of the output from the user's control system. 

4. The control system as claimed in any one of claims 1 to 3, characterized in that the control system further com- 
prises a virtual power limiter, which tunes a control input from the conservative control strategy to the user's con- 
trolled object in the user's control system on the basis of monitoring of virtual power in the virtual power monitor 

50 system, and thereby guarantees stability of the output from the user's control system and keeps controlling the 
user's controlled object. 

5. The control system as claimed in any one of claims 1 to 4, wherein the tuning by the virtual power limiter is applied 
to a gain of the quantity of negative feedback from the output of the user's control system to the Input to the user's 

55 controlled object, the user's control strategy, or the conservative control strategy to automatically tune at least one 
of the gains of the quantity of negative feedback, the user's control strategy, or the consen/ative control strategy 
in such a way that stability of the output of the user's control system is guaranteed. 
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6. A control system characterized in that the control system comprises: a power assist system, which has a user's 
controlled object controlled by an operator and includes a power assist control strategy that receives a feedback 
signal from the user's controlled object and assists to input a control input from the operator to the user's controlled 
object; and a virtual power monitor which monitors power transmitted from the operator to the user's controlled 

s object, and can evaluate and analyze stability of an output from the power assist system. 

7. The control system as claimed in claim 6, characterized In that the control system further comprises a virtual 
power limiter, which tunes the quantity of negative feedbacic from the output from the power assist system to an 
Input to the user's controlled object In the power assist system on the basis of monitoring of virtual power In the 

10 virtual power monitor to limit outflow of the virtual power from the power assist system to a virtual power monitor 
system, and thereby limits power flowing out of the power assist system to the operator to guarantee stability of 
the output from the power assist system to thereby secure safety to the operator 

8. The control system as claimed in claim 6 or claim 7, characterized in that the control system further comprises 
15 a virtual power limiter, which tunes a control input from the power assist control strategy to the user's controlled 

object in the power assist system on the basis of monitoring of virtual power in the virtual power monitor to limit 
outflow of the virtual power from the power assist system to a virtual power monitor system, and thereby limits 
power flowing out of the power assist system to the operator to guarantee stability of the output from the power 
assist system to thereby secure safety to the operator. 

20 

9. The control system as claimed in any one of claims 6 to B, characterized in that the tuning by the virtual power 
limiter is applied to the quantity of negative feedback from the output of the power assist system to the input to the 
user' s controlled object, or to the power assist control strategy to automatically tune a gain of at least one of the 
quantity of negative feedback or the power assist control strategy in such a way that stability of the output of the 

25 power assist system is guaranteed to secure safety to the operator. 
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